
package edu.wpi.first.wpilibj.templates.commands;

import edu.wpi.first.wpilibj.templates.*;
import edu.wpi.first.wpilibj.command.CommandGroup;

//import edu.wpi.first.wpilibj.templates.commands.DoDriveDistance;


/**
 *
 * @author Jaren Marler
 */
public class DoCollect extends CommandGroup {
    public DoCollect(boolean shoot){
        // Distance from rear of pyramid to discs under pyramid
        double d = 10.0;
        
        addSequential(new DoShooterInit());
        addSequential(new DoCollectorStowToPickup());
        addSequential(new DoDriveDistance(1.0, d));
        addSequential(new DoDelay(2.0));
        addSequential(new DoDriveDistance(1.0, -d));
        if (shoot) {
            addSequential(new DoAutoShoot2(false));
        }
    }
}